float32 camera_pose_x
float32 camera_pose_y
float32 camera_pose_theta

float32 filter_x
float32 filter_y
float32 filter_yaw

float32 predict_x
float32 predict_y
float32 predict_yaw

float32 cov_x
float32 cov_y